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gix + hiy + i 





FIG. 73 
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EQ 
NUMBER 


EQUATION 


64 


^ = CG + DFH 


65 


^ = CFH-DG 


66 


^ = ACG — BDG + ADFH + BCFH 


67 


*i = DE 


68 


'J.CH 


69 


= ADE + BCE 


70 


gi = J(DFG-CH) 


71 


hi = J(DH+ CFG) 


72 


i = J(BDH - ACH + ADFG + BCFG + /) + 1 


73 


2 2 
sin 0 + cos 0=1 


74 


0 = arctan(sin0, cosB) 



FIG. 79 
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EQ 
NUMBER 


EQUATION 




^ = A(CG + DFH) + B(CFH - DG) 


76 


c = Afl + 


77 


^ = A(DE) + £(C£) 


78 


/ = Arf + fle 


79 


i = AJ(DFG - CH) + BJ(DH + CFG) + IJ+1 


80 


i = Agi + Bhi + IJ+ 1 


81 


a c-Bb 

A = 

a 




A - f ~ Be 

CI 


83 


c-Bb _ f-Be 

n ~ d 


84 


cd — Bbd — af-Bae 


85 


B(ae — bd) = af-cd 


86 


B _ af-cd 
ae — bd 



FIG. 30 
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EQ 
NUMBER 


EQUATION 


87 


„ f af— cd\ 
A = d 


88 


_ f(ae - bd) - e(af- cd) 
d(ae — bd) 


89 


^ aef -bdf - aef + cde 
d{ae — bd) 


90 


^ - bdf+ cde 
d(ae — bd) 


91 


^ -bf+ce 
ae - bd 


92 


c = ^- 

ES 


93 


D = — 
ES 


94 


a = + ^FH 

E E 


95 


-d e 
b = -?G + ^FH 
E E 


96 


-e d 
e = —H+—FG 
s ES ES 


97 


d e 
ES ES 


98 


^ eG + dFH 

E = 

a 


99 


-dG + eFH 
E= b 



FIG. <3/ 
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EQ 
NUMBER 


EQUATION 


100 


„ c -eH + dFG 

g 


101 


„„ dH+eFG 
ES = h 


102 


eG + dFH -dG + eFH 
a ~ b 


103 


FH ad + be 
G ae — bd 


104 


-eH + dFG dH + eFG 
g ~ h 


105 


FG dg + eh 
H dh — eg 


106 


FH FG (ad + be)(dg + eh) 2 
G X H (np — hdMdh - pq \ 


107 


f - + K a d + be)(dg + eh) 
~i\(ae-bd)(dh-eg) 


108 


E = ±Jl-F 2 


109 


§ = arctan(£", F) 


110 


K.FH _ H _ f + \(ae-bd)(dh-eg)\..(ad+be) 
F G G V 4(ad+be)(dg + ehy " (ae-bd) 

!_ Had + be)(dh - eg) 

~4 (ae - bd)(dg + eh) 


111 


H H 1 



FIG. &2 
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EQ 
NUMBER 


EQUATION 


112 


H = — 
± 


1 


113 


rz _ 4- A /i _ fj^ 

V_Z — _!_ A/ L — 11 


114 


\\f = arctan(G, H) 


115 




116 


l 

S ±*Jd + e 
i E 


117 


^ e E 

C = x 

E _L. L 2 2 
±*Jd + e 


118 


C- 

_L. \i 2 2 


119 


d E 
D = x 

E L 2 2 


120 


j. J 2 2 



FIG. 33 
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EQ 
NUMBER 


EQUATION 


121 


i(l -Ag-Bh) = IJ+l 


122 


sign(i) = -sign(l - Ag - Bh) 


123 


y — arctan(D, C) 


124 


c di 
~ DE 


125 


s = 7k 

CE 


126 


sign(FH) = sign( ae _^ 


127 


J = 


gi 1 
-CH+ sign(FH)DFG\ 


128 


J = 


hi 

DH+sign(FH)CFG 


129 


j (i-Agi-Bhi-1) 

J 



FIG. 34 
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0 


O 


O 


±FJ 


O 


CFJ 


O 


±HJ 


DHJ 


±FGJ 


±HJ 


DHJ+ 
CFGJ 




0 


O 


O 


0 


—3 
LL 
-H 


DFJ 


±(-HJ) 


0 


-CHJ 


±(-HJ) 


±FGJ 


-CHJ+ 
DFGJ 




±BS 


±AS 


BS 


Bei 


Adi 


Adi+Bei 


+BS 


±AS 


Adi+Bei 


Bei 


Adi 


Adi+Bei 


'3 


±S 


0 


CS 


±ES 


0 


CES 


±S 


0 


SO 


±ES 


0 


CES 


■5 


0 


±S 


DS 


O 


±ES 


DES 


0 


±S 


DS 


0 


±ES 


DES 


0 


±AS 


±(-BS) 


Aai+Bbi 


±AS 


±(-BS) 


Aai+Bbi 


Aai 


Bbi 


Aai+Bbi 


Aai+Bbi 


Aai+Bbi 


Aai+Bbi 


!5 


0 


±(-S) 


-DS 


0 


±(-S) 


-DS 


0 


±(-GS) 


-DGS 


±FHS 


±(-GS) 


-DGS+ 
CFHS 


"c5 


±S 


0 


SO 


±S 


0 


SO 


±GS 


0 


CGS 


±GS 


±FHS 


CGS+ 
DFHS 


X 

ef 


0 


0 


0 


0 


0 


0 


H'O 


X 


X 


H'O 


X 

O 


X 
CD 


LL 

uT 


CD 




CD 


LL 

llT 


li_ 

LU 


E,F 


0 


o_ 


o_ 


u_ 

Ui 


u_ 
ui 


E,F 


Q 


±1,0 


0+1 


C,D 


±1,0 


0,±1 


a'o 


±1,0 


0,±1 


Q 
O 


±1,0 


0,±1 


0 
0 


case 


CD 




O 

T — 


CD 
CM 


CM 


0 

CM 


CO 


CO 


0 

CO 


CD 

■3- 


XJ 

^3- 


0 
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description 


case 


condition 


handling 


zero pitch & 
zero roll 


1 


g = h = 0 


E<r- 1 

G<- 1 
//<-0 


zero roll 


2a 


b = J = g = 0 


S a 


2b 


a = ^ = /i = 0 




2c 


a -h 
b~ g 


handle via 2a or 2b 


2 




G<- 1 
//<-0 

F<-sign(^)Vl-£ 2 



• 
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description 


case 


condition 


handling 


zero pitch 


3a 


b = d = h = 0 


G <— - 
e 

HJ _ -g 
S e 


3b 


a = e = g = 0 


HJ _ h 
S ~ d 


3c 


« _ S 

b h 


handle via 3a or 3b 


3 




E<r- 1 

F<-0 

H = sign(^)7l-G 2 


non-zero pitch 
& non-zero roll 


4 


(g*0)A(/l*0) 


handle via general solution 



FIG. 87 



